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@ Die Erfindung betrifft ein Verfahren zur Ermitt- 
lung von Fahrzeugdrehraten. wodurch Sensorprinzi- 
pien bedingte Storungen unterdruckt werden sollen. 
Einerseits soil bei der Navigation fahrerloser Trans- 
portsysteme die zeitabhangige Drift bei belcannten 
Kreiselsystemen vermieden werden. Andererseits 
sollen Fehlreaktionen von Radsensoren hinsichtlich 
der Richtungsinformation des Fahrzeuges, belsplels- 
weise beim Durchfahren von Schlaglochern. vermie- 
den werden. 

Abhilfe schafft hier ein Verfahren, nach dem ein 
in einer Krelselanordnung erzeugtes Drehratensignai 
18 einen Hochpaflfilter 20 passiert und ein von Rad- 
sensoren generiertes Drehratensignai 22 einen Tief- 
paflfilter 24 passiert, sowie die beiden danach auftre- 
tenden Einzelsignale 18*, 22* zur Ermittlung der 
Fahrzeug-lst-Drehrate zusammengefafit werden. 

Durch die Sperrwirkung des TiefpaCf titers wer- 
den - beispielsweise beim Durchfahren eines Schla- 
gloches - die dabei auftretenden sensorbedingten 
hochfrequenten Drehratensignale der Radsensoren 
eliminiert und konnen sich deshalb bei der Ermitt- 
lung der Fahrzeugdrehrate nicht mehr storend aus- 
wirken. Ferner vermeidet der HochpaiSfilter niederfre- 
quente Storungen, die beispielsweise durch die Drift 
eines Kreisels hervorgerufen wurden. Durch die Ver- 
knupfung der gefilterten Drehratenme/Jsignale kann 
auf einfache und schnelle Weise der Lagewinkel 



eines fahrerlosen Fahrzeuges ermittelt werden. 
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Die Erfindung betrifft ein Verfahren zur Ermitt- 
lung von Fahrzeugdrehraten nach den im Oberbe- 
griff des Patentanspruchs 1 angegebenen Merkma- 
len. Ferner sind Fahrzeuganordnungen zur Durch- 
fuhrung des Verfahrens Gegenstand der Erfindung. 

Aus der DE 31 11 130-AI geht die Gewinnung 
der Fahrzeugdrehrate aus einer Kreisetnavigation 
hervor. Nachtellig wirkt sich eine dem bekannten 
Kreiselsystem immanente Eigenheit einer zeitab- 
hangigen Drift aus, wodurch eine zeitabhangige 
Abweichung vom Sollkurs, insbesondere bei fahrer- 
losen Fahrzeugen, nicht zu vermeiden 1st. 

Aus der DE 30 03 287-AI ist ein selbstfahren- 
des Fahrzeug bekannt, bei dem frei mitlaufende 
Hinterrader mit Winkelgebern zu dem Zweck ange- 
ordnet sind, Informationen uber die Bahnlange und 
eines Kreisradius zur Fahrzeuglenkung zu gewin- 
nen. Als Winkelgeber warden hier Radsensoren 
eingesetzt. die jedoch stdranfallig sind, wenn bei- 
spielsweise das Fahrzeugrad durch ein Schlagloch 
fShrt. Durch eine derartige Storung veriiert der 
Radsensor die Richtungsinformation des Fahrzeu- 
ges. weil bei der Durchfahrt durch dieses Schla- 
gloch statistisch die Umdrehungszahl mindestens 
eines Rades verandert wird und dadurch kurzzeitig 
eine hohe Fahrzeugdrehrate sinngemafi weiterge- 
geben wird. was zu Fehlreaktionen des Fahrzeuges 
fuhrt. 

DemgegenOber Ist es Aufgabe der Erfindung, 
die Sensorprinzipien bedingten Storungen bei der 
Ermittlung der Fahrzeugdrehrate zu unterdrucken. 

Gelost wird diese Aufgabe durch die Im kenn- 
zeichnenden Tell des Patentanspruchs 1 aufgefuhr- 
ten Verfahrensmerkmale. Vorteilhafte Anordnungen 
zur Durchfuhrung des Verfahrens gehen aus den 
Merkmalen der Unteranspriiche hervor. 

Durch das erfindungsgemafie Verfahren kon- 
nen sich vorteilhaft fahrbahnbedingte Storeinflusse, 
wie beispielsweise ein Schlagloch. bei der Ermitt- 
lung der vorhandenen Fahrzeugdrehrate nIcht mehr 
negativ auswirken. Durch eine Storung hervorgeru- 
fene und beispielsweise belm Durchfahren eines 
Schlagloches auftretende sensorbedingte hochfre- 
quente Drehratensignale der Radsensoren werden 
durch die Spern^irkung belm Passieren eines Tief- 
pafifilters eliminiert und wirken sich deshalb bei der 
Ermittlung der tatsachlichen Fahrzeugdrehrate 
nicht mehr stSrend aus. 

Ferner wird eine durch die Drift eines Kreisels 
vorhandene niederfrequente StQrung in bezug auf 
die Ermittlung der tatsSchllchen Fahrzeugdrehrate 
dadurch vorteilhaft vermleden. dafi das vom Krei- 
selsystem erzeugte Drehratensystem einen Hoch- 
pa/Jfilter passieren mui3 und dadurch die aus der 
Drift resultierenden Verfalschungen vermieden wer- 
den. 

Durch Verkniipfung der betden vorlDeschriebe- 
nen gefilterten Drehraten-Me/Jsignale kann auf be- 



sonders einfache und schnelle Weise der Lagewin-r.. 
kel eines fahrerlosen Fahrzeuges ermittelt werden. 
Insbesondere konnen durch die einfache Driftellml- 
nierung preiswerte handelsubliche Kreiselsysteme 
5 eingesetzt werden. Die Erfindung wird anhand 
zweler in den Zeichnungen dargestellten Ausfuh- 
rungsbeispiele naher erlautert. 
Es zeigt: 

Rg. 1 ein fahrerlos betriebenes Fahrzeug In 
70 einer perspektivischen Ansicht, 

Rg. 2 eine schematische Darstellung der 
durch TiefpaBund HochpaBfilter gefil- 
terten Drehratensignale, 
Rg. 3 in einer schematischen Darstellung 
75 den Fahrzeugdrehwinkel, 

Rg. 4 in einer schematischen Darstellung 
den Verlauf der durch einen TiefpaiJfil- 
ter gefilterten Drehratensignale, 
Rg. 5 in einer schematischen Darstellung 
20 den Verlauf der durch einen HochpaB- 

filter gefilterten Drehratensignale, 
Rg. 6 den Verlauf des Drehratensignales bei 
einem abdriftenden Kreisel und bei 
3uBeren StoreinflDssen des Radsen- 
25 sors, 

Rg. 7 einen Kreisel- und Hinterradsensor be- 
zogenen storungsfreien Drehratensi- 
gnalverlauf, 

Rg. 8 ein welteres AusfQhrungsbeispiel. bei 
30 dem die Storungen der Drehratensi- 

gnale durch einen Kalman-Filter elimi- 
niert werden. 
In Fig. 1 ist ein autonomes fahrerloses Trans- 
portfahrzeug 14 dargestellt, das keine materiellen 
35 Leitschienen zur Lenkung benotigt und deshalb bei 
Anderung der Streckenfuhrung eine hohe Flexibili- 
tat besitzt. Zur Orientierung und Erzeugung der 
Lenkbewegung werden mitgefuhrte V\^nkel- und 
Wegme/3sensoren verwendet. Die Orientierung er- 
40 folgt dabei an inertialen Systemen, wie Kreisel 12 
und/oder mit Hllfe geeigneter Sensoren (Wegget>er 
10) an GegenstMnden der normalen Einsatzumge- 
bung. 

Das Fahrzeug 14 besteht im wesentlichen aus 

45 folgenden Baugruppen: 

Einem Untergestell 32, das eine kraftaufnehmende 
Zelle bildet und im oberen Bereich eine Montage- 
plattform zur Aufnahme kundenspezifischer Nut- 
zungsgerate tragt. Eine im vorderen Fahrzeugbe- 

50 reich nicht dargestellte Lenkung, die beispielsweise 
aus nur einem Lenkrad bestehen kann, Ist mit 
Antriebsmotoren und Getriebe ausgerOstet. wSh- 
rend das Feihrzeug in selnem hinteren Bereich zwei 
beidseitig angeordnete, iediglich mitlaufende Fahr- 

55 zeugrader 26 enthalt. 

Im vorderen Fahrzeugbereich sind bekannte 
Abstandsensoren 36 angeordnet die als Sicher- 
heitseinrichtung eine Kollision verhindern. Das 
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Fahrzeug kann automatisch, . von Hand oder nach 
einem Lernmodus betrieben werden, wozu maB- 
geblich fur die Lernfahrt eine Kamera 38 im obe- 
ren. vorderen Fahrzeug bereich angeordnet 1st. Eine 
Auswerteschaltung 16 enthalt verschledene elektri- 5 
sche EinschDbe 16.1. 16.2 etc., in denen alls Funk- 
tionen zentral gesteuert werden. Beispielsweise 
dient ein Einschub 16.1 dem Zweck, dafl die Ach-. 
sensteuerung die Lenkbefehle in Motoransteuerbe- 
fehle umsetzt. Ein welterer Einschub 16.2 ist mit w 
einer Elektronik zur Gewinnung der Ortsinformation 
aus dem Fahrsensor ausgerustet. 

Als Weggeber 10 dienen die unabhangig von- 
einander drehbaren Hinterrader 26, die mit elektri- 
schen Sensoren zur Ermittlung des zurDckgelegten 75 
Wages ausgerustet sind. Weicht der gemessene 
Weg des einen Rades 26 vom anderen ab, so hat 
sich das Fahrzeug 14 um einen in der Fig. 3 
dargestellten Drehwinkel a gedreht. Auf diese Wei- 
se kann uber die Radsensoren 10 unter Zuhilfenah- 20 
me der Auswerteschaltung 16 die Fahrzeugdrehra- 
te <l> berechnet und in entsprechende elektri sche 
Drehratenslgnafe 22 umgewandelt werden. Danrtit 
Storuhgen der Wegstrecke. beispielsweise ein 
Schlagloch. die Me^ergebnisse nicht beeintrachti- 25 
gen, und insbesondere dabei auftretende hochfre- 
quente Drehratensignale 40 (Fig. 6) kelne Fehlreak- 
tionen des Fahrzeuges hervorrufen, wird das von 
dem Radsensor 10 ermittelte Drehratensignal 22 
einem Tiefpa^filter 24 zugefuhrt, der ausschlieBIich 30 
nur die im storungsfreien normalen Fahrbetrieb des 
Fahrzeuges 14 auftretenden Drehratensignale 22 
durchla/Jt- Der TlefpaSfilter kann beispielsweise so 
ausgelegt sein, dafi er HF-Storungen im Bereich 
zwischen einer Drehrate von 10°/sec. und einer 35 
Drehrate von 90°/sec. unterdrOckt und ^ 10°/sec. 
durchlaBt. Die Fig. 4 verdeutlicht diese Charakteri- 
stik des Tiefpafifi Iters. Danach gelangen nur die 
von der Kurve 40 eingeschlossenen elektrischen 
Signale einer relativ geringen Fahrzeugdrehrate 22 40 
durch den Tiefpafifilter 24. 

Zur Vermeidung der eingangs beschriebenen 
und in der Fig. 6 dargestellten Kreiseldrift 19. die 
beispielsweise 10^/h betragen kann, muB das vom 
Kreiselsystem bestrmmte Fahrzeugdrehratensignal 45 
18 einen HochpaBfilter 20 passieren. Die Charakte- 
ristik eines derartigen Hochpa/Sf liters 20 ist in Fig. 5 
dargestellt. Danach werden der Drift 19 entspre- 
chend geringe Fahrzeugdrehratensignale 42 vom 
HochpaCfilter 20 nicht berucksichtigt. wahrend bei- so 
spielsweise Fahrzeugdrehratensignale 18 ^ l0°/h 
den Hochpafifilter passieren konnen. 

Die gefilterten Ausgangsslgnale der Fahrzeug- 
drehrate 18* und 22' werden anschlieJSend einem 
Summenverstarker 28 in an sich bekannter Weise 55 
zusammengefa/Jt. 

Durch die vorbeschriebene Unterdruckung der 
maiJgeblich sensorbedingten Storungen wird eine 



exakte Fahrzeugdrehrate 22 (Rg. 7) fOr den Soll- 
kurs bestimmt, wobel beispielsweise wMhrend der 
schlaglochbedingten Storung das von der Drift 19 
befreite Drehratensignal 18 den Sollkurs des Fahr- 
zeuges bestimmt. 

Den gleichen vorbeschriebenen vorteilhaften 
Effekt der Unterdruckung sensorbedingter Storein- 
fliisse kann durch einen eine HochpaB- und Tief- 
pai3filterung erzeugenden Kalman-Filter 30 erzeugt 
werden, wie er schematisch in der Fig. 8 darge- 
stellt ist. 

Dabei wirkt eine nicht naher dargestellte Ver- 
starkermatrix des Kalman-Filters so, da/J die aus 
der Kreiselanordnung 12 generierte Drehrateninfor- 
mation 18 durch eine HochpaBfllterschicht und das 
aus dem Radsensor 10 gewonnene Drehratensignal 
22 durch einen ebenfalis nicht naher dargestellten 
TiefpaB geschlckt wird. 

Die Navigation durch den Kalman-Filter 30 ist 
in den geschlossenen Schaltstellungen II und III 
moglich. Dabei gelangen die Drehratensignale 22 
des Radsensors 10 nach Verlassen eines fur die 
Beschaltung erforderlichen Netzwerkes 44 und die 
Drehratensignale 18 des Kreisels 12 nach Verlas- 
sen eines entsprechenden Netzwerkes 46 in den 
Kalman-Filter 30. Als Ergebnis wird die erhaltene 
Summenmatrix 48 mit den Sollwerten 50 der Fahr- 
zeugnavlgation verglichen und daraus der Fahrzeu- 
glagewinkel 52 berechnet. 

Bei glattem Boden ist auch eine einfache Be- 
triebsart nur mit Radencoder gemMfl der Schaltung 
I moglich, wahrend in der Schaltung II eine Kreisel- 
navigation durchfuhrbar ist. 

Die verwendeten Gerate: Hochpai3filter 20, 
Tiefpafifilter 24, Summenverstarker 28. Kalman-Fil- 
ter 30, Netzwerke 44, 46. Summenmatrix 48 sind 
im Handel erhaltlich und gehoren somit zum Stand 
der Technik, weshalb eine nahere Beschreibung 
dieser Telle entbehrilch Ist. 
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Che 1 bis 4, gekennzelchnet . duroh. einenr 
eine Hochpa^- und eine Tiefpa/Sfitterung erzeu- 
genden Kalman-Rlter (30). 



Patentansprtiche io 

1. Verfahren zur Ermittiung von Fahrzeugdrehra- 
ten. wobet ein Weggeber (10) der Fahrzeugbe- 
wegung entsprechende Signale erzeugt und 

eine Kreiselanordnung (12) fortlaufend die Aus- 75 
richtung des Fahrzeuges (14) erfaBt. sowie die 
vom Weggeber (1 0) und von der Kreiselanord- 
nung (1 2) erzeugten Signale In einer Auswerte- 
schaltung (18) verarbeitet werden, dadurch 
gekennzeichnet, daB jedes in der Kreiselan- 20 
ordnung (12) erzeugte Drehratenslgnal (18) et- 
nen Hochpafifilter (20) passiert. und daB jedes 
von als Weggeber (10) ausgebildeten Radsen- 
soren generierte Drehratenslgnal (22) einen 
TiefpaBfilter (24) passiert, sowie die danach 25 
auftretenden Einzelsignale (18', 22') zur Ermitt- 
iung der Fahrzeug- Ist-Drehrate zusammenge- 
faBt werden. 

2. Fahrzeuganordnung zur Durchfuhrung des Ver- 30 
fahrens nach Anspruch 1, gekennzeichnet 
durch einen der Kreiselanordnung (12) zuge- 
ordneten HochpaBfilter (20), der Drehratensi- 
gnate (18) in der GroBe der Driftfrequenz un- 
terdrQckt. 35 

3. Fahrzeuganordnung zur CXirchfuhrung des Ver- 
fahrens nach Anspruch 1, dadurch gekenn- 
zeichet, daB das von den auf zwei mitlaufen- 

den Hinterradern (26) angeordneten Radsenso- 40 
ren (10) ermittelte Drehratenslgnal (22) einem 
TiefpaBfilter (24) zugefOhrt wird. der aus- 
schlieBlich die im storungsfreien normalen 
Fahrbetrieb des Fahrzeuges (14) auftretenden 
Drehratenslgnale (22) durchl§Bt. 45 

4. Fahrzeuganordnung nach einem der Ansprii- 
che 1 bis 3, dadurch gekennzeichnet, daB 
der HochpaBfilter (20) und der TiefpaBfilter (24) 

mit einem Summenverstarker (28) verbunden so 
sind, in dem die von den Radsensoren (10) 
ermittelten und den TiefpaBfilter (24) verlasse- 
nen sowie die von der Kreiselanordnung (12) 
ermittelten und den HochpaBfilter (20) verlas- 
senen Drehratenslgnale (18*, 22') addiert wer- 55 
den. 



5. Fahrzeuganordnung nach einem der Anspru- 
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